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1.  Introduction 


A  Light  Detection  and  Ranging  (LIDAR)  laser  scanner  provides  2D  range  information  in  a 
horizontal  plane  ahead  of  the  scanner.  It  can  detect  obstructions  within  the  field  of  view  of  the 
scanner.  Such  data  are  useful  in  allowing  a  robot  to  avoid  obstacles  in  its  path.  The  objective  of 
the  Open-Path  Area  algorithm  described  in  this  report  is  to  search  the  region  scanned  by  the 
range  finder  for  the  most  open  path  that  will  allow  a  robot  of  a  specified  width  to  move  the 
furthest  distance.  If  the  identified  path  is  to  the  side,  the  robot  should  turn  in  that  direction  until 
the  path  is  directly  ahead.  Then  it  will  move  forward. 


2.  The  Obstacle  Array 


Figure  1  shows  a  sample  set  of  range  data  from  a  scanning  LIDAR  in  a  Cartesian  coordinate 
system.  The  LIDAR  is  located  at  the  bottom  center.  In  this  case,  ranges  are  obtained  every  half 
degree.  Index  zero  is  to  the  right;  index  180  points  directly  ahead;  and  index  360  is  to  the  left. 

To  search  for  an  open  path,  it  is  helpful  to  map  the  range  data  to  an  array  where  the  column 
indices  are  the  beam  numbers  and  the  rows  are  the  range  values  divided  into  an  arbitrary  number 
of  bins.  This  “Obstacle  Array”  is  shown  in  figure  2.  The  path  to  be  searched  must  also  be 
mapped  into  this  space. 
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Beam  index 


Figure  2.  Scanning  range  data  obstacle  array. 

The  width  of  the  path,  in  terms  of  beam  indices,  is  a  function  of  the  range  bin  index,  figure  3. 
Figure  1  shows  the  beams  that  impinge  on  the  sides  of  a  potential  path  at  two  sample  ranges. 

The  angle  subtended  by  the  left  and  right  beams  tapers  with  range.  By  geometry,  the  width  of 
the  vehicle  in  terms  of  scan  angle  is: 

Path  Width  (angle)  =  2*atan((Path  Width/2)/Range  (1) 

Subsets  of  that  shape  determine  the  open  area  of  the  path. 
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Figure  3.  Path  width  in  beam  indices. 


3.  The  Open-Path  Algorithm 


The  Open-Path  search  algorithm  checks  each  Beam  Index  as  a  potential  direction  and  finds  the 
Range  Bin  Index  at  which  the  path  is  obstructed.  Figure  4  shows  three  example  potential  paths. 
These  same  unobstructed  paths  are  shown  in  Cartesian  coordinates  in  figure  5.  The  areas  for 
each  unobstructed  path  need  to  be  found. 
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Figure  4.  Open  paths  (obstacle  array). 


Figure  5.  Open  paths  (cartesian). 

The  first  implementation  of  the  Open-Path  algorithm  created  an  actual  obstacle  array  from  the 
LIDAR  data  by  placing  a  value  of  one  if  the  element  was  unobstructed,  and  a  zero  if  it  was 
blocked.  Then,  subsets  of  the  path  width  to  be  searched  at  each  range  bin  were  methodically 
extracted  and  added  together  until  the  path  width  encountered  a  zero.  This  gave  the  area  of  the 
unobstructed  path.  Such  an  approach  was  highly  inefficient  because  an  obstacle  array  had  to  be 
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created  each  time  the  range  data  was  updated,  and  many  calculations  needed  to  be  performed  for 
every  beam  index.  Figure  6  shows  a  few  steps  in  the  systematic  search  of  the  path  width.  Each 
element  in  the  array  subset  is  checked  to  see  if  it  is  open  (shown  in  grey)  or  obstructed  (shown  in 
black).  Those  elements  that  have  been  searched  are  shown  in  white. 


Figure  6.  Open  path  search  in  obstacle  array. 
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It  became  apparent  that  constructing  the  obstacle  array  was  unnecessary  and  that  the  open  path 
areas  did  not  have  to  be  computed  at  each  step.  Instead,  the  range  data  from  the  LIDAR  could  be 
manipulated  directly.  The  range  data  consists  of  a  one-dimensional  array  containing  the  range 
values  for  each  beam  scan.  The  index  of  each  range  value  is  the  beam  index.  The  range  data 
could  be  divided  into  an  arbitrary  number  of  range  bins. 

Figure  7  illustrates  how  a  search  for  an  open  path  is  conducted  using  the  range  data  directly.  The 
ith  Beam  Index  (0  <=  i  <=  Number  of  Beams)  is  the  path  direction  being  checked.  For  the  ith 
Beam  Index  and  the  jth  Range  Bin  Index,  a  subset  of  the  range  data  is  extracted  between  indices: 

{ith  Beam  Index  -  (Path  Width(j)/2) ,  ith  Beam  Index  +  (Path  Width(j)/2)}  (2) 

Where  Path  Width(j)  is  the  width  of  the  path  at  the  jth  Range  Bin  in  terms  of  beam  indices  (0  <= 
j  <=  Number  of  Range  Bins).  If  the  subset  to  be  extracted  lies  outside  the  length  of  the  range 
data  array,  then  the  extracted  portion  of  data  is  cropped  on  the  appropriate  side. 


Then,  the  minimum  range  bin  value  of  the  data  subset  is  found.  If  that  minimum  range  bin  value 
is  greater  than  or  equal  to  the  jth  Range  Bin  Index,  then  the  path  is  clear  to  the  jth  Range  Bin 
Index.  The  algorithm  then  moves  on  to  check  the  next  Range  Bin  Index.  When  the  minimum 
range  bin  value  is  not  greater  than  or  equal  to  the  Range  Bin  Index,  then  the  path  is  blocked  at 
that  Range  Bin  Index  and  the  path  search  at  the  ith  Beam  Index  stops.  The  resulting  two  indices, 
the  ith  Beam  Index  and  the  jth  Range  Bin  Index,  at  which  the  path  is  last  open  identify  a  unique 
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subset  of  the  maximum  possible  open  path  area  of  the  shape  shown  in  figure  3.  Three  such 
examples  are  shown  in  figure  4. 

The  path  areas  for  every  Beam  Index  and  Range  Bin  Index  combination  only  need  to  be 
calculated  once  and  stored  in  a  look-up  array.  Figure  8  is  an  intensity  graph  of  such  an  array. 
The  largest  possible  open  area  that  can  be  scanned  would  be  directly  ahead  out  to  the  maximum 
range.  This  is  the  top  center  portion  of  the  graph.  Potential  path  directions  to  either  side  of  the 
center  shift  a  portion  of  the  path  out  of  the  scan  range  so  the  area  is  less.  Likewise,  shorter 
ranges  reduce  the  area  under  the  curve.  The  array  is  symmetrical  about  the  center  beam  index. 
The  open  area  for  each  potential  direction  is  read  from  the  array  using  the  Beam  and  Range  Bin 
indices  obtained  from  the  algorithm.  When  computing  the  areas  of  the  open  paths  included  in 
this  array,  it  is  convenient  to  divide  the  range  bin  indices  into  the  same  number  as  half  the  beam 
indices.  The  range  bin  index  obtained  from  the  algorithm  is  scaled  accordingly  for  the  look-up 
array. 


Figure  8.  Open  path  areas  look-up  array  (intensity  graph). 


Figure  9  shows  the  encountered  Range  Bin  Indices  and  resulting  open  path  areas  for  each  Beam 
Index.  The  Beam  Index  that  returns  the  maximum  open  path  area  determines  the  direction  the 
robot  should  turn  toward.  The  turning  rate  is  proportional  to  the  angle  from  the  forward 
direction  to  the  most  open  path.  Greater  angles  will  cause  the  robot  to  turn  faster.  When  the 
open  path  is  oriented  closer  to  directly  ahead,  the  robot  will  turn  slower.  The  Forward  speed  of 
the  robot  is  proportional  to  the  size  of  the  open  area  when  the  most  open  path  is  “directly  ahead.” 
Angles  to  either  side  within  some  reasonable  amount  would  qualify  as  directly  ahead.  When  that 


7 


area  is  below  a  set  threshold,  the  robot  will  reverse  and  turn  slightly  so  it  can  search  for  a  new 
path. 


4.  Results  and  Conclusions 


Figure  10  shows  the  path  taken  by  a  virtual  robot  under  the  control  of  the  algorithm.  The  robot 
responds  to  the  virtual  range  data  from  the  obstacles  by  turning  in  place  towards,  and  then 
moving  in  the  direction  of,  the  most  open  path  that  will  accommodate  the  width  of  the  robot. 
Figure  1 1  is  another  example  of  paths  found  through  a  cluttered  room.  The  robot  starts  at  several 
arbitrary  locations  and  orientations.  The  first  fan  of  laser  range  data  is  shown  in  red.  The  paths 
eventually  find  the  door,  but  the  robot  is  not  seeking  nor  is  it  attracted  to  the  door.  It  has  no 
knowledge  of  its  location.  The  robot  only  responds  to  the  door’s  presence  when  it  is  in  the 
LIDAR’s  field  of  view.  It  moves  toward  it  because  it  presents  as  a  more  open  path. 

The  algorithm  is  not  designed  to  seek  out  an  exit.  Rather,  the  robot  simply  wanders  along  the 
most  open  path.  This  does  not  guarantee  that  a  doorway  will  be  found,  as  shown  in  figure  12, 
where  the  robot  starts  in  a  large  empty  room  with  a  small  doorway  just  wide  enough  for  the  robot 
to  go  through.  The  path  the  robot  takes  approaches  the  door  on  several  loops  but  does  not  pass 
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through  it.  Since  finding  an  exit  or  entrance  may  be  a  desirable  capability,  a  means  to  do  so 
would  have  to  be  found. 


Figure  10.  Path  found  through  obstacles. 


Figure  11.  Paths  found  through  cluttered  room. 
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Figure  12.  Path  through  a  large  empty  room  with  a  small  door. 


5.  Conclusions 


The  algorithm  developed  proved  to  be  a  rather  robust  obstacle  avoidance  technique.  The 
algorithm  was  implemented  on  a  skid-steer  Segway  Robotic  Mobility  Platform  (RMP),  as  shown 
in  figure  13.  The  RMP  seemed  almost  intuitively  to  search  out  a  clear  path.  For  example,  it 
would  weave  its  way  between  traffic  cones  placed  in  random  order  in  front  of  it.  Also,  starting 
in  a  closed  area  surrounded  by  cones,  one  cone  was  arbitrarily  removed  to  create  an  opening  just 
wide  enough  for  the  RMP  to  pass  through.  The  RMP  would  move  around  within  the  area  until 
the  opening  came  within  view.  Then  it  would  line  itself  up  to  the  opening  and  exit  the  area.  It 
was  found  that  the  dynamic  motion  of  the  robot  precluded  an  exact  repeat  of  a  change  in 
direction.  This  proved  to  be  an  asset  as  it  ensured  a  bit  of  randomness  to  the  robot’s  path;  the 
robot  did  not  get  locked  into  a  repeating  pattern  and  eventually  “saw”  the  opening.  The  robot 
would  also  center  itself  while  going  down  a  hallway. 

The  Open-Path  Obstacle  Avoidance  Algorithm  described  in  this  report  results  in  a  fluid  robot 
motion  that  reacts  to  and  naturally  avoids  obstacles  in  its  path.  The  laser  range  data  are  quickly 
manipulated  to  identify  the  direction  of  the  path  that  is  least  obstructed.  The  algorithm  returns 
direction  and  range  indices  that  are  used  in  a  lookup  table  containing  the  open  area  of  the  path. 
These  areas  need  only  be  computed  once  and  stored.  The  algorithm  could  be  coupled  to  other 
algorithms  that  look  for  doorways  or  other  features.  A  robot  need  not  be  directed  to  go  in  the 
direction  of  the  most  open  area.  The  method  shown  to  determine  if  a  path  is  open  enough  for  a 
robot  to  fit  could  also  simply  be  used  to  check  if  goal  points  of  a  desired  path  are  unobstructed. 
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Figure  13.  Skid-steer  Segway  Robotic  Mobilty  Platform. 


11 


NO  OF. 

COPIES  ORGANIZATION 

1  ADMNSTR 

ELEC  DEFNS  TECHL  INFO  CTR 
ATTN  DTIC  OCP 

8725  JOHN  J  KINGMAN  RD  STE  0944 
FT  BEL  VOIR  VA  22060-6218 

1  DARPA 

ATTN  IXO  S  WELBY 
3701  N  FAIRFAX  DR 
ARLINGTON  VA  22203-1714 

1  CD  OFC  OF  THE  SECY  OF  DEFNS 

ATTN  ODDRE  (R&AT) 

THE  PENTAGON 
WASHINGTON  DC  20301-3080 

2  B/l-6  IN,  TF  1-35  AR 
1LTW  BROWN 

CAMP  STRYKER/COP  CASHE  SOUTH 
APO  AE  09322 

1  US  ARMY  RSRCH  DEV  AND  ENGRG 

CMND 

ARMAMENT  RSRCH  DEV  AND 
ENGRG  CTR 

ARMAMENT  ENGRG  AND 
TECHNLGY  CTR 

ATTN  AMSRD  AAR  AEF  T  J  MATTS 
BLDG  305 

ABERDEEN  PROVING  GROUND  MD 
21005-5001 

1  DEPARTMENT  OF  ELECTRICAL 

ENGINEERING  &  COMPUTER 
SCIENCES 

ATTN  MAJC  KORPELA 

646  SWIFT  RD 

WEST  POINT  NY  10996 

1  DIRECTOR 

MATHEMATICAL  SCIENCES 
CENTER  OF  EXCELLENCE 
646  SWIFT  RD 
WEST  POINT  NY  10996 

1  PM  TIMS,  PROFILER  (MMS-P) 

AN/TMQ-52 
ATTN  B  GRIFFIES 
BUILDING  563 
FT  MONMOUTH  NJ  07703 


NO  OF. 

COPIES  ORGANIZATION 

1  US  ARMY  INFO  SYS  ENGRG  CMND 

ATTN  AMSEL  IE  TD  F  JENIA 
FT  HUACHUCA  AZ  85613-5300 

1  COMMANDER 

US  ARMY  RDECOM 
ATTN  AMSRD  AMR 
WC  MCCORKLE 
5400  FOWLER  RD 

REDSTONE  ARSENAL  AL  35898-5000 

1 0  US  ARMY  RDECOM  TARDEC 

ATTN  MAJN  WIEDENMAN 
6501  E  ELEVEN  MILE  RD  BLDG  200C 
MAILSTOP  263 
WARREN  MI  48092 

1  NASA  LANGLEY 

ATTN  AMSRD  ARL  VT  M  NIXON 
BLDG  648  RM  252B 
HAMPTON  VA  23681-0001 

1  US  GOVERNMENT  PRINT  OFF 

DEPOSITORY  RECEIVING  SECTION 
ATTN  MAIL  STOP  ID  AD  J  TATE 
732  NORTH  CAPITOL  ST  NW 
WASHINGTON  DC  20402 

4  US  ARMY  RSRCH  LAB 

ATTN  AMSRD  ARL  VT  UV 
HL  EDGE 

ATTN  AMSRD  ARL  VT  UV 
R  VON  WAHLDE  (3  COPIES) 
ABERDEEN  PROVING  GROUND  MD 
21005 

1  US  ARMY  RSRCH  LAB 

ATTN  AMSRD  ARL  VT  UV 
S  WILKERSON 
BLDG  390 

ABERDEEN  PROVING  GROUND  MD 
21005 

1  US  ARMY  RSRCH  LAB 

ATTN  AMSRD  ARL  Cl  OK  TP 
TECHL  LIB  T  LANDFRIED 
BLDG  4600 

ABERDEEN  PROVING  GROUND  MD 
21005-5066 


12 


NO  OF. 

COPIES  ORGANIZATION 

1  DIRECTOR 

US  ARMY  RSRCH  LAB 
ATTN  AMSRD  ARL  RO  EV 
WD  BACH 
PO  BOX  12211 

RESEARCH  TRIANGLE  PARK  NC 
27709 

1  CADET  CORPORAL  C  VIQUEIRA 

PO  BOX  4461  USMA 
WEST  POINT  NJ  10997-4461 

3  ALBERT  B  BROWN  JR 

8912  TIMBER  TRAIL  COVE 
CORDOVA  TN  38018-7404 

3  US  ARMY  RSRCH  LAB 

ATTN  AMSRD  ARL  Cl  OK  PE 
TECHL  PUB 

ATTN  AMSRD  ARL  Cl  OK  TL 
TECHL  LIB 
ATTN  IMNE  ALC  IMS 
MAIL  &  RECORDS  MGMT 
ADELPHI  MD  20783-1 197 

TOTAL:  37  (1  ELEC,  1  CD,  35  HCS) 


13 


Intentionally  Left  Blank. 


14 


